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List of Abbreviations 


DOF - Degree of Freedom 

IMU - Inertial Measurement Unit 

INT - THEE TO PS INTERACTIVE file 

MSFC - Marshall Space Flight Center 

P/OF - Pinhole/Occnlter Facility 

VRCS - Vernier Reaction Control System 



1.0 INTRODUCTION 


The objective of this contract was twofold: 

1. ) To demonstrate the feasibility of using a generic simulation, 

TREETOPS, to simulate the Pinhol e/Occul ter Facility (P/OF). 

2. ) To determine the pointing performance of the P/OF using the baseline 

control system. 

In order to accomplish these objectives two tasks were defined: 

TASK 1.1 Modeling and 1REETOPS setup 

This task included modeling the structure as a three body problem 
including the flexibility of the P/OF 32 meter boos^ Modeling of 
the sensors, actuators and control algorithm was also required. 

TASK 1.2 TREETOPS Setup, Simulation and Analysis 

The TREETOPS simulation was defined based on the models of Task 1.1. 
Transient responses were obtained for comparison with previous anal- 
ysis results. 

During the execution of these tasks the direction of the contract was 
changed such that Honeywell would design and supply a control algorithm for 
use in TREETOPS and the comparison with previous results would be deleted. 

The detailed math models for the structure, sensors and actuators is 
presented in Section 4.1. The control algorithm and corresponding design 
procedure is presented in Section 4.2. The closed loop pointing performance 
using this controller is presented in Section 4.3. Computer listings of the 
simulation are presented in Section 5 for the sake of completeness. 
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2.0 CONCLUSIO NS 






Two Major conclusions were reached as a result of the study contract. 

1. ) The TREETOPS simulation is an excellent tool for this type applica- 

tion. Its generic nature gives us the flexibility to change Models 
easily and the 1 inear ixa tion option provides a natural link to 
control design tools. 

2. ) Steady state P/OF pointing to within 1 arcsecond appears feasible. 

I* should be noted that the eMphasis of this contract was on the feasi- 
bility of siMulation via TREETOPS and on control algorithm design as opposed 
to emphasing closed loop performance assessment. The transient pointing 
errors during orbiter maneuver periods were large (47 arcsec) but when the 
maneuvers were complete the steady state errors were small (less than 1 arc- 
sen). Our conclusion is that steady state errors will depend largely on 
sensor errors and noise rsther than loop dynamics. 

The next phase of this contract will model sensor snd sctuator noise and 
thus give a much better prediction of the steady state pointing error. 
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3.0 R E WM KSHPAT 10NS 




The objective of thia contract vas primarily to develop a TREETOPS baaed 
aiainlation of the P/OF. The aiaialation proved to be very uaefnl and our 
recommendation ia to uae the emulation for further atudiea oriented toward 
underatanding the performance limitationa of the P/OF. Specifically, we 
recoaMend three areaa of atudy that will provide aignificant near term bane- 
fita. 


1. IMPLEMENTATION - Thia taak would put the pointing control ayatem in a 
form auitable for digital computer implementation and would try to minimize 
the computer reaourcea required for implementation. 

2. STEADY-STATE PERFORMANCE - The addition of aenaor and actuator error 
aourcea to the simulation would allow aenaitivity atudiea for determining the 
relationahip between pointing accuracy and control ayatem characteriatica. 
Theae relationahip* would form the baaia for predicting pointing accuracy and 
the associated error budget allocationa. 

3. MOUNTING BASE - The current aimulation utilizes the shuttle orbiter 
as a mounting base. The viability of the P/OF concept would be enhanced if we 
showed acceptable performance for a variey of bases such as apace station, 
space lab or a free-flier base. 
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4.0 DISCUSSION 




4 


The purpose of this section Is to present the results of this study is 
they relete to the statement of work. Section 4.1 presents the detailed math 
models developed according to Task 1.1 of the contract. Section 4.2 presents 
the pointing control system design which was an add on task. Finally, Section 
4.3 presents the closed loop performance responses obtained from the simula- 
tion according to Task 1.2. 

4.1 HAITI M ODELS 

The simulation math model can be divided into four main parti: struc- 

ture, sensors, actuators and controller. 

4.1.1 Structure Math Model 

The structure being modeled consists of the Space Shuttle orbiter. 
Instrument Pointing System (IPS) and Pinhold Occulter facility as illustrated 
in Figure 1. We are treating the structure as three bodies connected in a 
chain configuration. The simulation is 3 dimensional (as opposed. to planar) 
and has 9 degrees of freedom in addition to the flexibility of the boom. The 
orbiter and IPS are both treated as rigid bodies while the boom is a flexible 
body. The orbiter has 6 degrees of freedom (3 rotation, 3 translation) wrt 
the inertial frame and the IPS has 3 rotational degrees of freedom wrt the 
orbiter. 

The IPS is modeled as a single 3 DOF hinge which means that the indivi- 
dual gimbals are not modeled. That part of the IPS outboard of the gimbals is 
combined with the P/OF sensors and the boom deployment canister to make up 
Body No. 2. 

The third body is the 32 meter flexible boom with the P/OF mask assembly 
mounted at the outboard end. It is connected to the canister with a zero DOF 
hinge representing a cantilever beam. The flexibility of the boom is repre- 
sented using the cantilever modes obtained from the finite element model 
supplied by MSFC. The three bodies and three hinges are illustrated in Fig- 
ures 2 through 4 and the corresponding TREETOPS input data is presented in 
Tables 1 through 6. 


AN ILLUSTRATION OF THE P/OF STRUCTURE 
FIGURE 1 


SPACE SHUTTLE 


INSTRUMENT 
POINTING SYSTEM 


PINHOLE OCCULTER 
FACILITY 



BODY #1 


SPACE SHUTTLE ORB ITER 
FIGURE 2 




FIGURE 3 
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P/OF COORDINATE FRAME AWD BINGE ILLUSTRATION 


* 


FIGURE 4 


BOOM ♦ MASK 


FRAME 




SPACE SUT1TLE ORB I TER 


TABLE 1 
(REVISION 1) 


1.) 

ID# 


- 1 

2.) 

TYPE 


- RIGID 

3.) 

MASS 


- 95395 Eg (210,311.5 LLS) 

4.) 

INERTIA 

- (Eg -a 2 ) 


<z« 

at 

1.261 x 10 6 (930.016 alug-ft 2 ) 


l yr 

m 

9.691 i 10 6 (7,148,059 alug-ft 2 ) 



m 

10.150 * 10 6 (7,485,903 alug-ft 2 ) 


I *y 

m 

1337 (986 alug-ft 2 ) 


!*, 

m 

3.125 z 10 5 (230,475 alug-ft 2 ) 


! y* 

■ 

-676.6 (-499 alug-ft 2 ) 


3.) ATTACH POINT COORDINATES (aetiri) 

27.736, -.0025, 9.469 (1092.0 in, -.1 in, 372 
6.) NODE #1 - MASS CENTER (aetera) 


27.736, -.0025, 9.469 (1092 .0, -.1 . 372 .8 in) 



TABLE 1 


(CONTINUED) 

7.) NODE #2 - HINGE POINT (meter*) 

25.527. 0. 10.566 (1005, 0, 416 in) 


NODE #3 = IPS ACCELEROMETERS (meters) 


25 

.527. 

0, 10.26 

(1005. 

0, 404 

in) 




NODE 

#4.5. 

,6. 7, 8, 9 - 

VERNIER JETS 

(meters) 




#4 

F5R 

8.24. 

1.52, 

8.89 

(324.4. 

59.7, 

350.1 

in) 

#5 

F5L 

8.24. 

-1 .52, 

8.89 

(324 .4, 

-59.7, 

350.1 

in) 

#6 

R5R 

39.75. 

3 .81. 

11.66 

(1565., 

149.9, 

45 9. 

in) 

#7 

L5L 

39.75. 

-3 . 81 . 

11.66 

(1565., 

-149.9, 

459. 

in) 

#8 

R5D 

39.75, 

3.0. 

11.57 

(1565., 

118., 

455.4 

in) 

H9 

L5D 

39.75 

-3.0, 

11 .57 

(1565., 

-118. . 

455 .4 

in) 
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BODY #2 




IPS + CANISTER 



TABLE 2 

1.) 

ID# 

= 2 

2.) 

TYPE 

- RIGID 

3.) 

MASS 

- 1873 Kg 

4.) 

MOMENT i 

OF INERTIA (Kg -a 2 ) 


X xx " 

12691 (9361 slug-ft 2 ) 


1 yy = 

12354 (9112 slug-ft 2 ) 



1903 (1404 slug-ft 2 ) 


i = 

0 


*y 



I , = 

0 


xz 



I _ ■ 

0 


y* 


5.) 

ATTAQI 

POINT COORD, (aeters) 


0,0.0 


6.) 

NODE #1 

- MASS CENTER (aeters) 


0.0, 

1.8 (5.9 ft) 

7.) 

NODE #2 

* HINGE POINT (aeters) 


0.0. 4.3198 

NODE #3 - RATE GYRO MOUNTING POINT (aeters) 

( 0 . 0 . 1 ) 
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BODY #3 


BOON + MASK 
TABLE 3 


1.) 

ID# 

- 3 

2.) 

TYPE 

- RIGID 

3.) 

MASS 

- 69.87 Kg 

4.) 

MOMENT OF 

INERTIA (Kg 


I xx - 653 91 
I yy - 65416 


5. ) ATTACH POINT COORD, (meters) 

0 , 0,0 

6. ) NODE #1 * HASS CENTER (meters) 

0,0, 29.92 

7. ) NODE HI = P/OF SENSOR MOUNTING POINT (meters) 


(0.0. 32.) 


HINGE #1 


TABLE 4 


1. ) ID# * 1 

2. ) INBOARD BODY ID# = 0 

3 . ) OUTBOARD BODY ID# - 1 

4. ) HINGE POINT NODE # - 1 

5 . ) NR - 3 

6.) ROTATION OPTION * GIMBALLED 


7.) 

“ 1 L( j ) 

= 

1.0.0 

8.) 

A ‘J 

= 

1.0,0 

9.) 

* 3 

3 L(j) 

= 

0,0,1 

10.) 

A ’J 

= 

0,0.1 

11.) 


= 

0,0,0 

12.) 

b« 

= 

0,0,0 

13.) 

e(t 0 ) 

S’ 

0,0,0 

14.) 

0 NULL 

s 

0,0,0 

15.) 

NT 

= 

3 

16.) 

*1 J 

= 

1.0.0 


*2 j 

s 

0,1.0 


^3 J 

s 

0,0,1 

17.) 

S 

r- 

0,0,0 

18.) 

B y 

3 

0,0,0 

19.) 

y (t o> 

= 

0,0,0 

20.) 

y NULL 

3 

0,0,0 
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HINGE #2 


IPS GIMBAL 
TABLE 5 


1.) 

ID# = 2 


2.) 

INBOARD 

BODY ID# = 1 

3 .) 

OUTBOARD 

i BODY ID# - 2 

4 .) 

HINGE POINT NODE # - 2 

5.) 

NR * 3 


6 . ) 

(ROTATION OPTION - NOT REQUIRED) 

7 .) 

I, 

*L( j) 

= 1,0,0 

8.) 


= 1.0.0 

9 .) 

A. 3 

J L( j) 

- O.o.l 

10.) 


- 0,0.1 

11.) 

K e 

= 0,0,0 

12.) 

Be 

= 0,0.0 

13 .) 

0 (t o ) 

= 0,0,0 

14 .) 

e NULL 

- 0,0.0 

15 .) 

NT 

= 0 
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HINGE #3 


CANISTER TO BOOM INTERFACE 
TABLE 6 

1. ) ID# = 3 

2. ) INBOARD BODY ID# - 2 

3 . ) OUTBOARD BODY ID# = 3 

4. ) HINGE POINT NODE # - 2 

5. ) NR - 0 

6. ) (ROTATION OPTION - NOT REQUIRED) 

7. ) I, = 1,0,0 

_1 L(j) 

8 . ) = 1 , 0,0 

9 . ) = 0 , 0,1 

3 L(j) 

10 . ) !, = 0 , 0.1 
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4.1.2 Sensor Math Models 


The P/OF simulation uses standard rate gyros mounted on the outboard 
portion of the IPS and accelerometers on the bate of the IPS. In addition, we 
hive added a special sensor that measures line of sight error, mask tilt and 
tip deflection of the P/OF boom. 

The two accelerometers are mounted at Node 3 of Body 1. Their input axes 
are aligned along the orbiter X and Y axes respectively. Node 3 of Body 1 
corresponds to a location on the base of the IPS. It should be noted thst the 
accelerometers were t<- be used for cancelling the disturbance effect of base 
motion but the technique which was based on a rigid boom did not work well for 
a flexible boom. The accelerometers remain in the simulation but are not used 
as part of the control system. 

The simulation has three standard rate gyros mounted at Node 3 of Body 2 
which is the instrument mounting plate on the outboard end of the IPS. Their 
input axes are aligned along the X, Y and Z axes of the IPS respectively. The 
X and Y gyros are used as feedback sensors for the roll and pitch axes respec- 
tively and the Z gyro is unused. 

The final sensor is a 1 ine-of-sight (LOS) sensor developed specifically 
for the P/OF simulation. This sensor has seven outputs defined as follows: 

1 pj ) 

2 P 2 ) tilt angles (rad) of mask plane wrt detector plane 

3 p 3 ) 

4 xj ) relative displacement (meters) of mask wrt detector due 

5 x 2 ) to elastic deformation 

6 6j ) line of sight error (radians) 

7 b 2 ) 

The geometry of the P/OF sensor is illustrated in Figure 5. The P/OF 
boom is modeled as a flexible body attached to the IPS (Body 2) in a canti- 
lever sense, i.e. the attach point has zero elastic deformation in both rota- 
tion and translation. If we let the vector p locate the tip of the boom 
(mask) wrt the attach point of the boom then the relative tilt and displace- 
ment measured by the sensor is simply the elastic deformation at node p. 

P - P J + u j (P) 

where is "rigid body location" of the mask node point, j is a body 
index identifier and u^(P) is the elastic deformation at node P. 
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P/OF ALIGNMENT GEOMETRY 


DETECTOR 

PLANE 


FIGURE 3 


or TARGET UNIT VECTOR 

4 
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NM, 


■re the 


- 5±'£<E>n£ 

k«i 

NHj 

- u J <£> - l *J(£>nJ 

k-1 

where nj[ the general ited coordinates of the body j, 4 '£v£) and <j|£(£) 
he aode slopes and mode displacements respectively of body j node £. 


The line of eight errors are defined in terms of the target vector Uy end 
the mask looation vector jp. 


■ p * «T - •!" *« «d 
o ■ line of sight angle 

Let the target vector be nominally 
located along the bore sight axis of the 
P/OF. 

«T - M 

Sp - sin 62 ill “ cos &2 sin &1 

+ cos 6 j cos 6j 43 

-p * ^1 _ ^1 12 + d3 

-p x “T ” “®l 4 i - 62 dj 



If We define (. end &2 as the line of sight errors about the dj and dj 
axes respectively then they can be computed as follows: 





-Up x ox 


The TREETOPS input data needed to define all the P/OF sensors are listed 
in Table 7 . 
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P/OF SENSOR DEFINITION 


TABLE 7 

1. ) IPS ACCELEROMETER (X) 

TYPE - ACCELEROMETER 
ID# - 1 

ATTACH POINT BODY ID# - 1 
NODE ID# - 3 
INPUT AXIS - 1,0,0 

2. ) IPS ACCELEROMETER (Y) 

TYPE = ACCEL 
ID# * 2 

ATTACH POINT BODY ID# - 1 
NODE ID# - 3 
INPUT AXIS - 0,1,0 

3 . ) IPS RATE GYRO (X) 

TYPE - GYRO 
ID# - 3 

MOUNTING POINT BODY ID# = 2 
NODE ID# = 3 
INPUT AXIS - 1.0,0 

4. ) IPS RATE GYRO (Y) 

TYPE - GYRO 
ID# - 4 

MOUNTING POINT BODY ID# - 2 
NODE ID# - 3 
INPUT AXIS - 0,1,0 
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TABLE 7 


(CONTINUED) 


5. ) IPS RATE GYRO (Z) 

TYPE - GYRO 

ID# - 3 

MOUNTING POINT BODY ID# - 2 

NOPE ID# - 3 

INPUT AXIS - 0,0,1 

6. ) P/OF LINE OF SIGHT SENSOR 

TYPE - LOS 
ID# “99 

MOUNTING POINT BODY ID# - 3 

NODE ID# - 2 

TARGET UNIT VECTOR - 0,0,1 
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4.1.3 Actuator Nath Models 


The P/OF sieiulation has s total of 9 actuators; 3 torque antors mounted 
on the ginbal axes of the IPS and 6 reaction Jets for the shuttle orbiter 
vernier RCS control systeei. Each of these ere standard TREETOPS actuators and 
the Input data necessary for their definition are presented in Table 8. 
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P/OF ACTUATOR DEFINITION 


TABLE 8 


1. ) IPS TORQUE MOTOR - ROLL - X 

TYPE - TORCUE MOTOR 
ID# - 1 

MOUNTING POINT HINGE 0-2 
AXIS # « 1 

2. ) IPS TORQUE MOTOR - PITCH - Y 

TYPE - TORQUE MOTOR 
ID# - 2 

MOUNTING POINT HINGE # - 2 

AXIS # - 2 

3. ) IPS TORQUE MOTOR - YAW - Z 

TYPE - TORQUE MOTOR 
ID# - 3 

MOUNTING POINT HINGE # - 2 

AXIS # - 3 
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TABLE 8 


(CONTINUED) 


4. 5,6.7. 8. 9.) VERNIER RCS JETS 


MOUNTING POINT 


TYPE 

JET 

ut 

4 

BODY H 

NODE # 

OUTPUT AIIS 


i 

4 

.03263. -.69623, 

.71**»8 

JET 

5 

- 

3 

.03263. .69623, 

.71706 

JET 

6 

1 

6 

0 . -.99967, 

.02382 

JET 

7 

1 

7 

0 , .99967, 

.02382 

JET 

8 

1 

8 

-.02636, -.28662, 

.93768 

JET 

9 

1 

9 

-.02636. .2866?., 

.93*»68 
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4.1.4 Controller Math Model 


TREETOPS hat the capability for simulating three types of controllers; 
continuous, discrete and user defined. The P/OF simulation has 3 separate and 
distinct control systems and they are all embedded within the user defined 
controller. An overview of the user controller is presented in the intercon- 
nect diagram. Figure 6, which also defines the inputs and outputs. The 3 
separate control systems are 1) the roll gimbal pointing control, 2) the pitch 
gimbal pointing control and 3) the vernier RCS orbiter attitude control. 

ROLL AND PITCH GIMBAL POINTING CONTROL 

The roll and pitch gimbal controller both utilize the full state control- 
ler discussed in Section 4 2. The full state controller was developed for the 
pitch axis and when used for the roll axis it requires a phase change (sign 
reversal) on the tip deflection input, x*- Both pointing controllers have 
provisions to use the accelerometer feedbacks for disturbance rejection but 
the gain on these feedbacks is currently set to zero. 

URBITER VERNIER RCS CONTROL LAW 

The vernier RCS control system fires jets to hold the orbiter at the 
initial attitude or maneuver to a commanded attitude. The inputs are attitude 
commands supplied by the user via user controller inputs 11, 12 and 13. 

UUSER(ll) = roll attitude command (deg) 

UUSER(12) » pitch attitude cosunand (deg) 

UUSER(13) = yaw attitude command (deg) 

The vernier RCS control law consists of 4 primary parts as illustrated in 
Figure 7. 

PHASE PLANE The phase plane operates on each axis (roll, pitch ard yaw) 
to determine whether positive, negative or zero RCS control torque is required 
to null attitude and rate errors. Hysteresis is included to reduce jet on/off 
cycling. Disturbance acceleration logic sets up one sided limit cycles that 
remain within the attitude error deadbands while maximizing the time between 
jet pulses. The phase plane logic is illustrated in Figure 8. 

JET SELECT The jet select logic will select a set of 1, 2 or 3 vernier 
RCS jets to produce the control torque requested by the phase plane. The jets 
to be used are selected via a " dot product" approach. That is, the control 
torque produced by each jet is projected (dot product) onto the desired torque 
vector. The jet with the largest projection is turned on. If a second jet 
with at least half the projection of the maximum jet is found, then it is 
turned on. Similarly, if a thill jet is found with 40% of the maximum projec- 
tion it also is turned on. 

STATE ESTIMATOR The stste estimator is patterned after a fixed gain 
Kalman Filter. The state is extrapolated forward to each control instant 
(12.3 Hz) assuming that acceleration is constant over the interval. The 
states are then updated based on attitude measurements at 6.25 Hz rate. The 
estimator has threo separate filters for attitude, rate and disturbance accel- 
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ei.tt ion. The bandwidth of each filter ia tuned to improve the overall perfor- 
mance of the system. The equations for the state estimator are presented in 
Figure 9. 

ATTITUDE PROCESSOR The attitude processor computes the incremental atti- 
tude changes between successive sample times. It should be noted that the 
inputs to the phase plsne are angular rate and its integral. The integral of 
rate is not in the strict sense an attitude measurement except for planar 
rotation. The integral of rate is computed by summing the incremental atti- 
tude changes where the incremental rotations are about the body axes. In the 
flight system the attitude is measured by the I1IU. For this simulation we 
have neglected IMU dynamics by extracting the direction cosines directly from 
the truth model and computing angular increments as shown in Figure 10. 
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VERNIER RCS STATE ESTIMATOR 


VERNIER RCS ATTITUDE PROCESSOR 
FIGURE 10 
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4.2 FULL STATE CONTROLLER 
4.2.1 Introduction 


The "full state controlled is a pointing control systen for the P/GF. 

It uses identical control algorithms for pointing of both the roll and pitch 
gimbals of the instrument pointing system (IPS). The third gimbal allows 
rotation about the 1 ine-of-sight axis and is currently uncontrolled. 

The full state controller was developed primarily for the purpose of 
demonstrating the closed loop performance capability of the TREE TO PS simula- 
tion. As such, the control design does not represent a finished product, but 
it does demonstrate the feasibility of the approach and it also provides a 
basis for further refinement and development. 

4.2.2 Salient Features 

1. ) Uncoupled Axes - The P/OF boom is constructed such that the bending 

modes are uncoupled between axes. This allows us to separate the 
three axis model into three single axis models for the purpose of 
control system design. Furthermore, the roll and pitch axis models 
are nearly identical enabling the use of identical control algor- 
ithms for the two axes. 

2. ) Reduced Order Model - The full state controller is based on optimal 

Linear Quadratic Gaussian (LOG) design techniques and requires full 
knowledge of the system state for implementation. Computational 
requirements are minimised by reducing the state vector dimension 
which for the P/OF is equivalent to reducing the number of bending 
modes. The model used for control dtsign and implementation uses 
two modes per axis and is a derivative of the verification model 
which uses eight modes; four in the roll axis, three in pitch and 
the final one is a torsion mode. 

3. ) Sensors - Three sensors are used for each axis. The first senses 

line of sight error which is the basic control variable of the P/OF. 
The second measures bending deformation of the boom tip with respect 
to its base allowing the control system to null bending motion. The 
third sensor is a rate gyro mounted on the IPS and used to provide 
inner loop stability. The TREETOPS simulation uses these sensors 
together with an observer to estimate the state vector rather than 
simply extracting the state from the simulation for use fn the 
controller. 

4.2.3 Deslin Methodoloav 

The full state controller i.i based on LQG design techniques and was 
accomplished using two computer programs; TREETOPS and UONEY-X. The basic 
procedure is to first create a multi-body, 3-axis, non-linear model on 
TREETOPS. Second, use the TREETOPS linearization option to compute a linear 
model for input to UONEY-X. Third, develop a single axis model and design the 
control system using IIONEY-X. Fourth, install two copies (one each for roll 
and pitch) of the single axis controller into TREETOPS for evaluation in a 
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fully coupled, non- linear ainulation. 

The TREETOPS model uaed for the design process has 13 degrees of freedom! 
3 rotation and 3 translation DOF's for the orbiter with respect to inertial 
space, 3 rotation DOF's for the IPS gimbals and 4 bending DOF's for the P/OF 
boom. Each DOF is described by a second order differential equation which 
means the state vector dimension will be 26. 

The linear model obtained from 1REETOPS has the following standard form: 

2 - Ax ♦ Bu 

r ■ Cx ♦ Du 

where : 

x ■ state vector dimensioned 26 
u * input vector dimensioned 9 
r * output vector dimensioned 12 

and the constant coefficient matrix quadruples are dimensioned A(26,26), 
8(26,9), C(12 ,26) , D(12,9). 

The input, output and state vectors are defined in Figure 11. 

The s.'ngle axis linear model was obtained from the three axis model by 
selecting the pitch axis variables and deleting the rest to form the model 
presented in Figure 12. 

We can now compute an "optimal" controller for this system using l.UG 
design techniques. This controller has the form shown below. 



The control gain K c is defined as follows: 

For the cost function 

J * 1/2 /* (x^Qx + u*Ru)dt 
the optimal control is given by 

t c - r _1 b t l 

A 

where 1 is i solution of the non-linear matrix equation 
-LA - A 1 ! + IBR _1 B T L - Q - 0 
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PINUOLE/OCCULTER FACILITY STATE VECTOR DEFINITION 
(REDUCED ORDEK MODEL) 

FIGURE 11 
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PINHOLE/ OCCULTER FACILITY SINGLE AAiS LINEAR MODEL 

FIGURE 12 




0 5.065E-4 2.018E-4 0 1.387E-2 1.183E-1 

0 -2.125E-2 -7.377E-3 0 -5.819E-1 -4.326 

0 -4.287E-3 -6.035E-2 0 -1.174E-1 -35.396 

1 0 0 0 0 0 

0 1 0 0 0 0 

0 0 1 0 0 0 




8.037E-5 
-2.934E-3 
-6 .791E-4 
0 
0 
0 


iTy] 
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The cost (unction* Q and R were chosen to penalise line of sight erroi 62 
end torqne motcc commands T y resrective ly. 

6 2 " 

where 0 is the thir:! row of matrix C 
Q - D T o 2 D 


where o is a noreializing function chosen as 1 arcsec. 

a 2 - (1/1 arcsec) 2 - (206264 rad) 2 - 4.23 z 10 10 
R was chosen as (1 newton-sie ter) 2 


The resulting gain matrix, I c , was obtsined using HONEY-X. 


I - (728866 18874.7 126.068 206132 3968.17 201.292] 

c 

Now that we have a controller gain, K c , the nezt step of the design 
process is to design an observer that will estimate the state vector. The 
observer will have the forsi 


z - Ai + Bu* ♦ I Q (r - r) 

A 

• _ 
a “ -I c i 


I “ C x 

A A 

£ “ C x 

A A ^ 

where x, r are the estimated state and measurement vectors, u is the optimal 
control and Kq is the observer gain matrix. The observer gain matrix Kq is 
computed by the UONEY-X program KF1LT which solves the Ricatti equation 

A T P + PA 1 ' + Vj - P^V^CP - 0 


where A, C are the system matrices, P is the error covariance matrix and Vj, 
V2 are the plant disturbance noise and measurement noise matrices. 


Since we do not have good knowledge of the system noitrt characteristics 
we used the loop shaping techniques developed by the Honeywell System Research 
Center to choose Vj and V2 and thereby obtain acceptable loop frequency responses. 
The state noise is assumed to enter the system through the actuators or system 
inputs. The measurement noise is arbitrarily set to unity and p is s ratio of 
measurement noise to disturbance noise which is varied until acceptable per- 
formance is achieved. 


v 2 - I 


V. - pBD 


for a value of p^lO 1 the following observer gain was obtained along with 
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acceptable loop characteristics. 

' 2.J0058E1 -1.S3860E1 1 .91755E-1 

-8.26491E2 5 .79737E2 9.02389E0 

(K 0 ) - -1 . 91229E2 1.23491E2 1 .93675EO 

6.72379E-1 -4.77782E-1 8.15181E-1 

1 .3493221 3 .04520E1 4.70318E-1 

. -3 .631 91 EO 6 .82726EO 9.98093E-2 

The structure of the fall state controller is shown in Fi|nre 13. The 
values for the sjrstea natrices A, B, C are defined in Figure 12 and the 
controller and observer gains are defined previously in this section. For 
this sisiuletion the observer was left in the continnoue doaain and a fourth 
order Runge-Eutta algorithm waa used for the nuaerical integration. In future 
work we would cast the filter in the discrete doaain and use transition 
aatrices rather than nuaerical integration to propagate the state between 
control saaple instants. 
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CONTROLLER 



P/OF LINE-OF-SIGHT POINTING 










4.3 PERFORMANCE ANAL YSIS 


The 1REETOPS simulation v.as used tc determine the transient response of 
the P/OF pointing control system to disturbance inputs. We chose a three axis 
orbiter VRCS attitude maneuver as the disturbance. The attitude command was 
-.2, -*-.2 and -.2 degrees for the roll, pitch and yaw axes respectively. This 
combination was selected because it produces a worst case combination of jet 
pulses with pulse durations as lonr as 4.5 seconds. The orbiter attitude is 
shown in Figure 14 and rates in Figure 15. The attitude reached .3 deg in 
each axis before the maneuver was completed. This is equal to the command, 

+ .2°, plus the attitude deadband, +.1°. 

The P/OF pointing error corresponding to this disturbance is shown in 
Figure 16. During the period when the orbiter is maneuvering there is a 
steady state error because the system has no integial control. The transient 
errors are damped to less than 1 arcsec within 10 seconds. The torque motor 
outputs necessary to stabilixe pointing are shown in Figure 17. 


ORB ITER ATTITUDE vs. TIME 
for a 3 axis VRCS maneuver 



TIME (SEC) 









ORB ITER ANGULAR RATES vs. TIME 
for a 3 axis VRCS maneuver 



TIME (SEC) 






P/OF LINE-OF-SIGHT POINTING ERROR 
vs. TIME during a 3 axis VRCS maneuver 



TIME (SEC) 



P/OF TORQOE MOTOR OUTPUTS vs. TIME 
for a 3 axis VRCS maneuver 



TIME (SEC) 






3 .0 COMPUTER 1.1 STINGS 


In order to completely reproduce the results presented in Section 4.3, s 
user needs ■ copy of the TREETOPS program, the TREETOPS input (INT file) for 
the P/OF simulation, the modal data file and the user supplied control subrou- 
tine. The TREETOPS program is documented in other sources, the input data 
file (RJVPU6 .INT;1) and user control source program (POFCONT.FOR) are included 
herein for the sake of completeness. 


no no o n o o 


* TY ROFCTINT. R3R 

SUBROUTINE UCQNTROL<TIME.U,R) 

EINENSION DESrtT T <3).U<I),R<l), JET0N<6> , Y*3> ,X1 < 1 0) , X2C 1 0> 
♦,XC<10) 

DATA IFIRST sQs 
C r 

IF< IFIRST. EQ. 1 )G0 TU 100 
INITIALIZE THE VERNIER RCS CONTROLLER 
AND THE FULL STRTE GIMBRL CONTROLLER. 

RCGAIN=0 
INIT=— 1 

CALL FCS< INIT, DESRTT, JETON) 

INIT-0 

CALL FCS< INIT, DESRTT, JETON) 

DT-. C£ 

CALL FSCONT< INIT, DT, XI, XC,Y, TEMP) 

CALL FSCJNT < I NI T , DT , X2 . XC , Y , TEMP ) 

I 123*4 
INIT*l 
IFIRST*1 
100 CONTINUE 

»••»♦»♦♦♦♦ POLL GIMBRL CONTROL LRU ♦♦♦♦♦♦♦♦♦♦■»»♦♦•♦♦♦»»♦♦*♦♦•» 

YU>=UC3> 

Y<2)»-U<4) 

Y<3)»U<5) 

CALL FSCONT < INIT, DT , XI . XC. Y, TEMP) 

R<1 >»TEMP-RCGAIN*U<2> 

R<2>=2 06264. 0^U<5> 


/ 2 /:?o/W 


♦♦♦♦♦♦♦♦♦♦ PITCH GIMBRL CONTROL LAW ♦♦♦»»♦»♦»»♦«»♦♦♦ »♦»»•♦■»♦«*» 

Y(1)=U(8) 

Y<2)=U<9> 

Y(3>*U< 1 0> 

CALL FSCONT < I N I T , DT . X2 , XC , Y , TEMP ) 

RC3)*TEMP+RCGAIN^U<7> 

R<4>=2 06264. 0#U< 1 0) 


♦♦♦♦♦♦♦♦*♦ ORB I TER VERNIER RCS CONTROL LRU »♦♦♦♦♦»»♦»»• 
1 125*1 125+1 

IF«; I125.LT. 4 >GO TO 101 
1125=0 

• DESRTT Cl) =-U < 1 1 ) 

DESRTT <2'»= U< 12) 

DESRTT < 3 ) *-U < 1 3 ) 

CRLL FCSC INIT, DESRTT, JETON) 

R<3)=JETON<1>M09. 

R < 6 >= JETON < 2 )♦ 1 09 . 

R<7)»JZT0N<3)*-106.8 
R<8)»JETON<4)M06.8 
R<9)=JET0N< 5)^64. 68 
R< 1 0 >= JETON < 6 >*64. 68 
101 CONTINUE 
RETURN 
END 


o o o n o o o o o 


.SUBROUTINE FCSONIT, DESRTT. JETON) , 

DIMENSION SVJRCSC3) . RJCMDC3) , UDACCC3) , JET0NC6) 
DIMENSION RflTESTC3),ATTITUDE<3),AE<;i),WE<3),DESRTT<3) 
C 

IF<INIT)100, 200,300 
100 CONTINUE 

SET PARAMETER DEFAULT VALUES 

CALL STRTEST < INIT. DWRCS. ATTITUDE, RATEST, UDRCC) 

CALL OPHPLC INIT, RE, ME, UDRCC, RJCMD) 

CALL JET SELECT < INIT. RJCMD, JETON, DWRCS) 

RETURN — ‘ r *-* " * — “ 

♦ SET INITIAL VALUES FOR FLIGHT CONTROL MODULES 
200 CONTINUE 

CALL STRTEST Cl NIT, DWRCS, ATTITUDE, RATEST, UDRCC) 

CRLL JET SELECT < INIT, RJCMD, JETON. DWRCS) 

RETURN 

♦ TIME HISTORY COMPUTATIONS 


C 


C 


300 CONTINUE 

CALL STRTEST < INIT, DWRCS. ATTITUDE, RATEST, UDRCC) 
TO 3 I AX* 1.3 

RE< I AX)=ATTI TUDE< I AX )— DESRTT < I AX) 

3 WE< IPX>=RATE3T < IPX) 

CALL OPHPLC INIT. RE, WE. UDRCC, RJCMD) 

CALL JET SELECT < IN IT. RJCMD, JETON, DWRCS) 

RETURN 

END 

SUBROUTINE ATT?ROC< INIT, DELATT) 


DIMENSION DELATT <3) , CTO. 3) , C( 3.3) 
INCLUDE 'DBF. FOR" 

INCLUDE ' DBB.FOR" 

IF<INIT>100.2G0,300 
100 CONTINUE 
RETURN 

200 CONTINUE 

DO 201 1=1,3 
DO 202 J=1 , 3 
202 CT< I, J»=0. 0 

201 CT< I , 1)=1. 0 
RETURN 

300 CONTINUE 

CALL MXM<CT . CTRANS< 1, 1, 1),C,3,3,3,3) 
DELATT <1>=<C<2,3)-C<3,2> ) ♦28. 6479 
DELATT(2)=<C< 1.3)-C<3, 1) )*28. 6479 
DELATT <3)=<C<1 ,2)-C<2, 1 >>*£8.6479 
DO 301 1=1,3 
DO 301 J=1.3 


OWC-.a’AL 

OF- ‘POOR Q'OAwi • * 



301 CTCI. J)»CTRANS<J,I, 1) 

RETURN 

END 

SUBROUTINE STRTESTCINIT, DURCS. ATTITUDE, ONEGO 1 , RLPHA2) 

DIMENSION DURCSC3) , RTTITUDE<3) . DELRTT (3) , THETAMC3) , 

♦THETRt <3) . THETR2<3) , DELYK3) , DELY2<3> , 

♦OMEGA 1 (3> , DMEGB2<3) . ALPHR2<3> 

C 

IF<INIT)100,200,3no 
100 CONTINUE 

C 

C ♦♦♦♦♦ SET DEFAULT VALUES ♦♦♦♦* 

TMEAS=. 16 
TDAP*. 08 
TDPP2-TDAP/2. 

ATGRIN1-. 064 
RTGAIN2-1. 0 
RGRIN1-. 0016/TMERS 
R6AIN2-. 013/TMERS 
ACCGRIN=6.4E-3'<TMEAS~2> 

CALL RTTPROCCINIT, DELRTT) 

RETURN 

200 CONTINUE 
C 

C ♦♦♦♦♦ SET INITIAL CONDITIONS ♦♦♦♦♦ 

DO 201 1*1,3 
DURCS< I ) = 0. 

ATTITUDES I ' = 0 . 

THETAM<I>=0. 

THETA in '*0. 

THETR2<I>=0. 

OMEGA1 < I >=0. 

QMEGR2< I >=0. 

PLPHA2<I)»0. 

201 CONTINUE 
1625*0. 

RETURN 

300 CONTINUE 

C 

C ♦♦♦♦♦ EXTRAPOLATE THE XTRTE 0* ALL THREE FILTEPRS ♦ ♦♦♦♦ 

TO 301 1=1.3 

ATTITUDES I >=ATTITUDE< I >*TDAP^< ALPHA2C I >>TDAP2+0MEGA1 < I >*DWRCS< I > > 

r 

THETA 1 < I ) =THETA1 < I > -*-TDRP^< ALPHR2< I > ♦TDAP2+0MEGA1 ( I > ♦DURCS< I > > 
OMEEA1 < I >»0MEGA1 < I ) ♦T DAP^ ALFHA2 C I )>DWRCS< I ) 

C 

THETR2< n = THETA2< I ) +TDRP^ ALPHA2< I ) ♦TDRP2+OMEGR2 < I ) *♦ DWRCS< I > : 
0MEGA2C I >*C!MEEP2'' I >+TDPP^ALPHB2< I >+EURCS< I > 

C 

301 CONTINUE 

C ♦♦♦♦♦UPDATE THF. STATES AT 6.25 HZ RATE ♦♦♦♦♦ 

1 6 25= 1 625-*- 1 
IFCI623.EQ. l)GO TO 2 
1625=0 


'-'•uui! I, 4 * t' * iS 

OF POOR QUALITY 


n o r, n o 


♦ CALL ATTPROC < INIT. DELATT) 

DO 302 1-1,3 

C * 

THETRM < I > -THET AN < I > +DELRTT < I > 

C 

ATTITUDE ( I )=THETRM< I > 

C 

DELY1 < I >-THETAM< I >-THETAl < I > 

THETA 1 < ! >=THETA 1 < I **ATFA IN 1 ♦DELY 1 CI "- 
OMEGA 1< I > -OMEGA 1 < I ">■*■ RGR I N 1 ♦DELY 1(1) 

C 

DELY2( I >-THETAM< I >-THETA2< I > 

THETA2< I > i HETA2< I >+ATGAIN2^EELY2< I ) 
nHEGR2( I >*0MEGA2< I ) +R6R I N2 ♦DELY2< I ) 

RLPHA2< I >*RLPHR2( I >+RCCGRIN^DELY2< I ) 

C 

302 CONTINUE 
2 CONTINUE 
RETURN 
END 

SUBROUTINE JET SELECT ( IMIT. RJCMD, JETON, DURCS) 
DIMENSION JFU<6).RJCMD<3>. JETDN<6; 

DIMENSION HFAII_<6>, 

♦ □JET 0N(6) . DURCSC3) , OR JCMD < 3 ) , AMG I NC ( 6 , 3 > , 

♦VJCMD< 3) . RQTVALC3) 

INTEGER I.J.FAILC, JETC , JETON « 0 JETON , 

♦INIT.M.K.Q.R.S 

REAL FSFLAG. RJCMD, JF'J. X. VFAILD, 

♦DMRC3. OR JCMD, V JCMD. POTVAL, 

♦ MRSFEAT. THRESH2. THRESH3, 

♦ANGINC , I J3L. KJSL. 

♦VAL1 , VRLX, VALY, VRLZ 

LOGICAL HFAIL, JFCF, VFRIL 
DRTA<<RNGINC<I , J). J«l,3), 1*1,6 
♦—• 4401E— 03 . 0.7197E-03 . -.6793E-03 , 

♦0.4401E— 03 , 0.7197E-03 . 0.6793E-03 , 

7501E— 03 , -.159JE-04 , 0.5561E-03 , 

♦0. 7500E-03 . -.1553E-04 , -.5561E-03 , 

♦— . 7300E— 03 , -.3407E-03 , 0.7697E-n4 . 

♦ 0.7800E-03 . 34 OS E- 03 . -.7699E-04 

C 

INPUTS: RJCMD <3 ) = ROTRTICN CDMhRNB < 1 . 0, -1 > <R, F, Y> 

OUTPUTS: JETQN< 6) - RCS JET COMMAND <1*OH,0* OFF) 


IF< IMIT) 1,2.3 : 
1 CONTINUE 
MREPERT * 5 
THRESH2 * .50 
THRESH3 = .4 
DO 3 I = 1,6 
8 0 JETON < I) = 0 


DO 9 I - 1,3 
9DRJCMD<I> - 0 
KJSL - 0 

2 RETURN OhiGt'.'.'AL f • f 

C THIS PROGRAM IS THE ON-ORBIT DAP JET SELECT LOGIC OF POOR 
C FOR THE VERIER JETS VUMLI 

C 

c 

C RJCMDC3) ROTATIONAL CMOS 

C 

C COHSTRNTS* PNG INC = ANGULAR PRTES 

C MREPFRT * NUMBER OF FASSES IJITHOUT CMD CHPNGE <5> 

C THPESH2 * THRESHOLD FOP 2ND VERNIER JEK.50) 

C THRES3 « THRESHOLD FOR VERNIER JET 3<.4> 

C 

C OUTPUTS* JETON<*> - PCS JET COMMANDS 
C DVRC3 - DELTA 0ME6R RCS 

C 



3 CONTINUE 
DO 3 1-1,6 

3 JETC'NC I ' = 0 
VRLX * 0 
VRLY » 0 
VRLZ - 0 
Q = 0 
R * 0 
S - 0 

c 

C CHECK IF VERNIER CMOS ARE DIFFERENT FROM LAST PASS 

C OR MAX REPEAT IS EXCEEDED 

C 

M*0 

DO 40 I - 1.3 

I F < < I NT < RJCMD < I > > . HE . OR JCMD < I > > . OR . \ KJSL. E Q . MREPEAT > > M= 1 
40 CONTINUE 

I F M . ME. 1 > GO TO 300 

C CHECK IF ABS< VERNIEH CMD) =1.0 

C 

IF< ' ABS<RJCMD< 1 > > . EQ. 1. 0> . QR. < ABS<RJCMD<2> > . EG. 1 . 0 > . OR. 
♦<ABS<RJCMD<3>>.EQ. 1. 0)> 60 TO 50 
GO TO 200 
C 

30 CONTINUE 

C 



C CONDUCT TESTS 1-3 FER FIG. 4.2.2 2.1-20 

C TO SELECT VERNIER JF.T CMDS <JET0N<l-6> 

C 

C TEST 1 FIND MAX OF ANG INC ♦ VECTOR< VJCMD) 

DO 70 I « 1,6 
VAL1 * 0 








. DO 80 K - 1,3 

VRLl - VRLl ♦ RJCMD<IO*RN6INC< 1,10 
• 80 CONTINUE 

IF< VRLl . GT. VRLX) GO TO 75 
GO TO 70 
75 VfiLX « VRLl 
Q * I 

70 CONTINUE 

C TEST 2 FIND 2ND MBX OF RNG I NC» VECTOR (VJCMD) >THRESH2*VRLX 
DQ 90 I = 1.6 
VRLl » 0 

IFa.EQ. 3> GO TO 90 
DO 100 K » 1,3 

VRLl - VRLl ♦ RJCMD<K>*RNGINC< I,K) 

100 CONTINUE 

IF< < VRLl. GT.<THRESH2>VBL>0>.RND.< VRLl. GT.VRLY>> GO TO 95 
GO TO 90 
95 VRLY - VRLl 


R - I 

90 CONTINUE 

C TEST 3 FIND 3RD MRV OF PNGINC*VECTOR<VJCND> >THRESH3*VRLX 
IF(R.EO.O) GO TO 120 
DO 120 I » 1,6 
VRLl * 0 

IF< < I . NE. Q) . RNO. < I . ME. R) > GC TO 105 
GO TO 120 
105 DO 110 K « 1.3 

VRLl = VRLl + RJCMDOO^PNGINCCI.IO 
110 CONTINUE 

IF<*< VRLl . GT, CTHRESH3^VRLX) > . RND. ( VRLl . GT . VRLZ) > GO TO 115 
GO TO 120 
115 VRLZ » VRLl 

S - I 

120 CONTINUE 

C oET JETON < 39—44 ' FFP RESULTS OF TESTS 1-3 <Q,R,S^ 

JETON<rQ>»l 


IF<R.ME. 0 > JETCN<P ’ = 1 
IF<S. HE. 0> J£TON< S) - 1 
200 CONTINUE 

C COMPUTE DELTR OMEGR RCS 
DO 220 K = 1.3 
DURCSOO— 0. 0 
DO 220 t » 1.6 

IFC JETON< I ) . EQ. 1 >Dl.lRCS<K>-DldRCS<K)-*-RNGINC< I , K> 
220 CONTINUE 
KJSL * 0 
DO 260 1-1.3 
ORJCMDfl) * INT<RJCMD< I ) ) 

260 CONTINUE 

DO 270 1-1.6 
Q JETON < I > * JETOfK I > 


iA (A o n o n o o 


*270 r COIfT I HUE 
60 TD 310 

300 KJSL m KJSL ♦ 1 

ED ?:0 I - 1.6 ORIGIN • Fi *- ^ 

jETomn - ajETDiui) 0F P00R quality 

310 CONTINUE 
RETURN 
END 


C 

SUBROUTINE OPHPL< INI T. RE. ME.UDRCC, R JCMD) 

C 

C ON-ORBIT PHASE PLANE 

C 

DIMENSION AE<3),WE<3>.DB1<3>.RLIMIT<3>,ACC<3>. 

♦ UD ACC <3>.WMIN<3>. R JCMD < 3 > , BYPASS ( 3 ) , WFR ATE < 3 > , 

♦ Xt<3).Yt<3), X2<3> . Y2<3> 

C 

IF<INIT)100,2G0.300 

100 CONTINUE 

C SET DEFAULT VALUES 
DO tOl I-t.3 
WFR ATE < I ) » 0 . 8 
DBKI>-0. 1 
RLIMIT < I )-. 02 

101 CONTINUE 
ACC< t > — . 0) 872 
RCC<2>*.01096 
ACC < 3 > — . 0126-4- 
VMIN< 1 > — . 001872 
WMrN<2>«. 001096 
WMIN<3>«, 00 l £64 
RETURN 

200 CONTINUE 
RETURN 

300 CONTINUE 
DEFINE LOCAL VARIABLES 
DO 301 I AX-1.3 

XI < IPX) = SI6N< 1 . . WE< IPX) >*AE< IPX) 

X2<I«X> » ABS< WE< I AX) ) 

YKIPX) ■■ SI6N< 1 . 0. UDACC< I AX> >^AE< I AX) 

Y2< IPX) - SIGN( 1 . O.UDACCC I AX) >*WE< IHX) 

C -1.0 

IF<ABS<RJCMD< I AX) > .NE. 1.0) C« 1.25 

DEFINE SWITCHING LINES 

CEV IB DELETED ABS UDACC PER CR12710 
UCP - ACC«'IAX>-Sl«N*' 1. ,WE<IAX>>*UDACC<IAX> 

- 0 . 0 
- 0.0 


on no o o non non o n o noon 


IFOiCP .EQ. 0.0> GO TO 103 

S - -<X?<IRX># , <e<IRX))/ , <2.0^UCP> 
t - -<Y2<IAX>^Y2<IRX>V<2. 0»UCP> 

103CONTXNUE 

C 

51 - S ♦ DB1 < IRX) 

SI Y » SY «■ DBKIPX) 

52 - S*C - 1.2*0B1<IAX> 

S2Y - SY*C - 1 . 2-*DBt < IRX) 

53 ■ RLIMIT< IRX) 

Sa > 0. A*RLIMIT<IP,''» 

S3 * 0.6^RLIMIT< IRX:* 

S7 « <— l )4SI6N< 1 . . Y2< IPX) )♦<— 1 . >^SY-D31 < IRX) 

S3 « -RLIMIT < IRX) 

S10 ■ <-t.)*OSY ♦ 1 . 2+DB1 < IAX> 

IF<<Y1<IRX > .LT. <— . 3>^DB1< "RX) > . AND. < Y1 < IRX).GE.<-1 . c.) »DB t < IRX> 

♦>) 

♦ Sil ■ 0.0 

IF<<Y1<IRX >. GE. -0. 3+DB1 < IflX) ) • AND. <Y1 < IRX> . LE. SI 9) 

♦ ) SU » -SORT C ^ 

♦ 2. O^R'flS < UDRCC Cl RX ) ) ♦<?T<lfl&)+0. 50BI <£flX > > ) +WM I N < I RX > 

IF<S1 1 .GT. 0.0) SU - 0.0 

IF<S1 l.LT. < -PLIMIT < IAX>+WI1IN< IRX) ) >S1 1*-RLIMIT< IRX>«-WMIN< IRX) 

S 14 * -SY DB1 < IPX) 

PHRSE PLANE CONTROL LOGIC 


RE6I0N l CONTROL 

IF<<X1<IRX ). GT. SU.0R.<X2< IRX) . GT. S3) ) GO TO 10 
REGION 2 CONTROL 

♦♦DISTURBANCE HYSTERESIS REGION^ 

IF<<X1<IRX ). GE. S2) . RND. <X1 < IRX) .LE. SI ) . AND. <X2< IRX) . LE. S3) ) 

♦ GO TO 13 

REGION 3 CONTROL 

IF<<X1<IRX J.LT.S2). RND. <X2< IflX).LT.35>-> GO TO 23 
REGION 4 CONTROL 

IF<<X1<IRX ). LT. S2> . RND. <S4. LE. X2URX) ) . AND. <X2< IRX) . LE.S3) > 

♦ GO TO 33 
REGION 3 CONTROL 

IF< <X1 < IRX) , LT .S2) . RND. <S3. LE. X2< IHX) ) . RND. <X2< IRX) .LT.S4 ) ) 

♦ GO TO 40 
WRITEC6, 1000) 

1000 FQRMRT < 'PHASE PLANE ERROR - FRLLS THRU REGION 3 LOGIC') 

GO TO 80 



PHASE PLANE ACTION 


REGION 1 ACTION 


10 CONTINUE 

RJCND< IflX) = -SIGN< 1 . , UE< IflX) ) 
GO TO 80 


■ 

OF i 


YJTY 


REGION 2 ACTION 

♦ ♦DISTURBANCE HYSTFPESIS REGION i_OGIC 
REGION 2 ACTION, CS REGION CONTROL 


13 CONTINUE 

IF<< <S2Y. LE. Yt < IflX) ) . AND. < Y1 < IflX) .LT. S7) . AND. < Y2< IflX) . GE. 0, 0) . AND, 

♦ <Y2<IAX).LE.S3)>.0R.<<S14.LT.Yl<IAX>).flND. <Y1 < IBX) .LE. SI 0) 

♦ . AND. <S8. LE. Y2< IflX) ) . AND. < Y2< IflX) . LT . SI 1 ) ) ) GO TO 20 

DISTURBANCE HYSTERESIS REGION 1 


■>'<<<S7.LE. Y1 ( IflX) ) . AND. <Yl(IflX).LE.SlY). AND. <Y2<IflX).GE. 0. 0).AND. 
• <Y2< IPX) . LE. S3) ) . OR. < <S7. LE. Y1 < I AX) ) . AND. <Y! (IflX) . LE.S1 0) . AND. 
► <S1 1 . LE. Y2< IflX) ) . AND. < Y2< IflX) . LT .0.0))) GO TO 21 

DISTURBANCE HYSTERESIS REGION 2 
DEFAULT DISTURBANCE HYSTERESIS 


GO TO 23 


CS REGION ACTION 
20 CONTINUE 

RJCMD(IAX) = SIGN< l . 0 . UDflCC < I AX ) ) ♦MFRflTE < IflX)* 
♦ < < S 1 1 -Y2 < I flX ') >x<RLIMIT< IflX >+S 1 1 > ) 

GO TO 30 

HYSTERESIS REGION 1 ACTION 


21 CONTINUE 

IF<RJC:;ii<IflX).EQ.-SIGN<1.0,UDACCaflX))> GO TO 30 

22 CONTINUE 

RJCMD< IflX) = <-l.)*SIGN<1.0,UDRCC<IAX))«MFRATE<IRX)< 
♦ (. <Y2< IAX>— SI 1 )^<RLIMIT < I AX) -SI 1 ) ) 

GO TO 30 


HYSTERESIS REGION 2 ACTION 
DEFAULT ACTION 


o o o o o o n 


53 CONTINUE 

IF<RJCMD< I AX) . EQ. SIGN< 1 . 0, UDACC< IPX' > ) GO TO 80 
RJCMD<IAX) - SI6 K 1 . 0. UDACC< I AX) )-*HJF nrtTE< I AX)^ 

♦ <<S1 1-Y2< IAX> J^vRLIMITC IAX)+S1 1 > ) 

GO TO 80 

REGION 3 ACTION 

23 CONTINUE 

RJCMD< I AX) = SIGN< 1 . . WEC I AX) ) 

GO TO 80 

REGION 4 ACTION 

33 IF<RJCMD< IRX) . EQ. -SIGN< 1 . 0, UE< IRX) > ) GO TO 80 

RJCND < I AX )=-S I GN < 1 . 0 . WE< I AX ) >*WFRATE <1 AX >« < < 0. 8^RLIM I T < I AX ) 
♦— X2< IRX) )✓< 0.2^RLIMIT< IAX>) ) 

GO TO 80 

40 IF<RJCMD< I AX) . EQ. SIGM< 1 . 0, UE( IflX> ) > GO TO 80 
RJCND ( I AX > =S I GN < 1 . 0. WE< I AX) >«WFRATE< IAX>* 

♦< < 0. 8*RL MIT< IAX)-X2< IHX) )✓< 0. 2^RLIMIT< I AX) ) > 

GO TO 80 


30 

31 
301 


C 


CONTINUE 

CONTINUE 

CONTINUE 

RETURN 


END 

SUBROUTINE FSCONT< INIT. DT. X.XC, Y, R) 

DIMENSION A<6,6 > . IK6) . KC<6) , K 0(6, 3) 

DIMENSION C<3, 6) , BKC<6, 6) , SUN <6. 6),K0C<6,6),Y«.3) 
DIMENSION K 0 Y ( 6 ) . SUMX ( 6 ) , BKCXC ( 6 ) , XD < 6 > , X < 6 > , ERR ( 6 ) 
DINENSION XD0<6) , XC<6) 

REAL KC, KO, KQC, KOY 
DIMENSION PHI <6).X0<6) 

IFCINIT.GT.O)GD TO 100 
DT2=DT/ / 2. 3 
DT6=PT/6. 0 


C ZERO MATRICES A, B,K0,C.KC,C AND VECTORS X,XC,XD0 

DO 1 1=1,6 

B< I)=0- 0 

I KC< I >=0. 0 

' X<I)=0.0 

xca >=o.o 

XD0< I > = 0. 0 


DO 1 K=1 . 6 

A < I , K ) = 0 . 0 
1 CONTINUE 
DO 2 1=1,6 
DO 2 J= 1 . 3 

KOCI. J> = 0. 0 
CCJ, I ) = 0. 0 


aT'caNfiNUE 

ENTER NON-ZERO VALUES INTO A 

A<1,2>* 5. 06313E— 04 
A<1.3>« 2.01764E-04 
R< 1 • 3>= 1.38E93E-0? 

R<1,6>= 1.183278-01 

A<2.2>=-2. I 2523E— 02 
A f . 2 , 3 >=-7 . 37S79E- n? 

R<2. 5>=-5. 81931E— Ot 
A<2, 6 >=-4 . 2c620E+0n 


R< 3 , 2> =-4 . 286Q6E-03 
R(3.3)=-6. 03547E-02 
A<3,3>*-1. 17383E-01 
A<3,6>— 3.53937E+01 

R<4. 1>»1. 0 
A<5,2>»1. n 
A<6,3>»1. 0 

-ENTER THE NON-ZERO VfiLUES OF B 

B( 1 >= 3.0374DE-05 
B<2>=— 2. 933SEE— 03 
B<3>=-6. 79078E-04 

-ENTER NON-ZERO VALUES INTO KC 


KCC1>= 7.23366E+05 
KC<2>= 1.E8747E+II4 
KC<3>= 1.26068E+02 
KC<4>« 2. 061 522+0“! 

KC<3>= 3- 96917E+03 
KCX6>= 2* 01c9?E+0? 

ENTER NON-ZERO VALUES INTO KO 

K0C1. 1 )= 2. 30058E+01 
K0< 1.2)=- 1 . 53860E+*H 
K0< 1,3^= 1 . ? 1755E— Cl 

K C< 2 . 1 > =-R . 2649 1 E+ 02 
K 0 C 2 , 2 > = 5.79737E+02 
K0<2, 3 j>= 9. 02389E+00 

K0< 3, 1 >=-l . 91229E+02 
K0<3.2>= 1.25491F+02 
K0<3,3)= 1.93E75E400 

K 0 < 4 , 1 > = €>. 72379E— 01 
K0^4, 2>=-4. 77782E— 01 
K0<4,3>» 8. 15181E— 01 


» f p i r 

. U 


K0<3. 1 >=-l . 54932E+01 
K0<5,2>= 3.04320E+01 


■ EU«,3)* 4.7 0 318E-01 

j C 

' , K0<6.1>— 3.63191E+00 

K0<6.2>- 6. 82726E+00 
K0<6,3>« 9.98093E-02 

C 

C ENTER NON— ZERO C 

C(l,l)=1.0 

C<2. 5>=1 . 0 

CC2, 6 >=-£. 935 14E— 02 

C'3,4>= 9. 99983E— 01 

C<3,5>= 3. 125 OPE— 02 

Ct3,6)=- 9. 17230E-04 

C CALCULATE BXKC.KOC.SUM 

CALL MXM(B, KC, BKC. 6. 1.6,1) 

CALL NX«CK0,C,KDC,6,3,6,3> 

00 3 1-1.6 
DO 3 J-1,6 

3 SUM<I, J)«A<I. J)-KOC<I, J)-BKC<I. J) 
C 

C START DYNAMIC LOOP 

C 

100 CDN.INUE 

C COMPUTE STATE RATES, XB 

CALL MXTKKO, Y.KOY.6,3, 1,3> 

CALL MXMC SUM, X. SUMX.6. 6, 1 , fa) 

CALL MXMCBKC,XC.BKCXC,6,6, 1.6> 

DO 11 1-1.6 

1 1 xd< i >*kov< i >+sunxa >+ekcxcc i > 

C INTEGRATE STATE VECTOR 

BO 20 1-1,6 
X0<J)=X< I> 

PHI < I >— XD< I > 

20 X< I )— X0< I >+XD< I >^DT2 
C 

CALL MXM<SUM V X, SUMX.6, 6, 1,6) 

BO 21 1-1,6 

XD< I )=KOY< I > +SUMX < I )+3KCXC< I > 

PHI < I >=PHl < I >+2. «#XD< I > 

21 X<I)=X0<I)+XD<I)^DT2 

C 

CALL MXM < SUM. X. SUMX.6, 6, 1.6) 

BO 22 1*1.6 

XD< I ) -K 0V< I > +SUMX < I ) +BKCXC < I ) 

PHI < I )=PHI < I >+XD< I )4^. 0 

22 X( l )— X0< I )+XD< I )*DT 
C 

CALL MXM<SUM.X. SUMX.6. 6, 1,6) 

BO 23 1-1.6 

XD< I )=K0Y< I )+SUMX< I ) +BKCXC< I ) 

XC I )*X0< I )+<PHI(I >+XD( I ) >«DT6 

23 ERR<I)=XC<I)-X< D 

c 

C COMPUTE CONTROLLER OUTPUT, R 

tF.LL MXM < SCC, ERR .R. 1.10.1. 10> 

' RETURN 

.... ..CNT> 
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